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Abstract 

Kalman filter technniques are widely used in the areas of attitude and orbit 
determination, prediction and calibration. These techniques work well if the 
system dynamics are well-defined. Problems arise, however, when the system 
parameters are unknown ahead of time or changing over time. 

This paper discusses an adaptive Kalman filter design that utilizes recursive 
maximum likelihood parameter identification. At the center of this design is the 
Kalman filter itself, which has the responsibility for attitude determination. At 
the same time, however, the identification algorithm is continually identifying 
the system parameters. The approach is applicable to nonlinear as well as linear 
systems. This adaptive Kalman filter design has much potential for real-time 
implementation, especially considering the fast clock speeds, cache memory 
and internal RAM available today. 

The recursive maximum likelihood (RML) identification algorithm is dis- 
cussed in detail, with special attention directed towards its unique matrix for- 
mulation. Next, the procedure for using the algorithm is described along with 
comments on how this algorithm interacts with the Kalman filter. 

Finally, a spacecraft attitude determination/calibration example is pro- 
vided. In the development of the dynamics for this example, the angular veloc- 
ity of one of the axis is assumed to be constant. In the simulation, however, this 
velocity varies slowly. The RML identifier is used to continually identify this 
changing velocity. This AKF-RML method may be used to identify multiple 
parameters such as sensor biases or external torques. 

‘Hughes Aircraft Company, Aurora, Colorado 

1 Mechanical and Aerospace Department, North Carolina State University 


255 


1 Introduction 

A problem that has received recent attention is the estimation of systems whose 
dynamics are unknown or changing. In these situations, it is often neccessary to 
utilize an estimation algorithm that is able to adjust the system dynamics model au- 
tomatically. Self-adjusting estimation schemes are known as adaptive filters. There 
are many examples of systems with unknown or changing dynamics, several of which 
have just recently become more of a concern. 

Spacecraft attitude and orbit estimation are two such areas. Many current 
operational spacecraft do most of the attitude estimation, prediction and calibration 
on the ground using large mainframe computers. Recent literature, [19] and [23] for 
example, has suggested on-board attitude prediction and calibration using adaptive 
filtering techniques. Adaptive filtering methods have already been used for some 
time in spacecraft orbit estimation [27]. 

Adaptive filter techniques have also been applied in the steering of ships [28] 
and has been suggested for use in calibrating ocean navigational gyros [21]. Indus- 
trial processes research has led to the development of adaptive filter algorithms for 
monitoring chemical processes. Chen, Wadhwani and Roberts [3], for example, offer 
an adaptive filter technique for monitoring changes in raw material composition. 

Adaptive control methods often utilize adaptive filters. An extensive amount of 
literature has surfaced within the last fifteen years in the field of adaptive control of 
robotic manipulators alone. An example of a robotic manipulator adaptive control 
scheme is discussed in detail in an article by Lee, Kelly and Karim [15]. 

A relative newcomer to the field of adaptive filtering is large space structures 
(LSS). Larger spacecraft offer several advantages over smaller spacecraft including 
longer on-orbit lifespans (thus, fewer launch vehicles are required), on-orbit refueling 
(for lower orbit spacecraft) and more or larger payloads. As these spacecraft increase 
in size and complexity, some problems arise. A larger, more complex spacecraft will 
have lower bending frequencies, more fuel slosh, larger disturbances [11] and the 
possibility of greater interaction between multiple payloads [10]. Adaptive filtering 
techniques have been proposed for use in identifying parameters such as vibrational 
frequencies, damping coefficients, and attitude estimation. 

Accurately estimating the states of a system whose dynamics are time-invariant 
and known is often easily accomplished. There are numerous estimation methods 
for accomplishing this task, depending on the particular application, blew problems 
are created, however, when the system has unknown or time-varying dynamics. If 
estimation is attempted for system dynamics that are incorrectly modelled, large 
errors in the estimated states are likely. Even more problems may arise if control 
is to be applied based upon the estimated states. It is clear that a state feedback 
regulator applying control to a system based upon these incorrect states may have 
problems determining the correct amount of control to apply, possibly causing the 
system to go unstable. 
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This paper discusses an adaptive filter technique that utilizes a Kalman filter. 
Adaptive filters based upon Kalman filters are known as adaptive Kalman filters 
(AKF). This AKF design is developed in the second and third sections, then applied 
to a satellite attitude determination problem in Section 4. 

2 A RML Identification Technique 

2.1 Motivation for Develop m ent 

Using a Kalman filter-based adaptive filter offers several advantages over other adap- 
tive filter techniques. Even though it may be computationally intense depending 
upon the application, the adaptive Kalman filter design provides the capability to 
easily provide the system states where and when they may be needed. A large space 
structure system could be designed so that the states are the structure’s attitude 
(pitch, roll, yaw and their rates). For this example, the AKF could serve as not only 

the state estimator, but the provider of these estimated states to other payloads as 
well. 

To be adaptive, however, the AKF must be able to accurately identify unknown 
or time- varying system parameters. The burden of this task falls upon the identifier. 
Since it may be desireable to use a Kalman filter-based adaptive filter, it seems 
reasonable that the identifier algorithm chosen should be one that works well with 
a Kalman filter. This chapter will cover the development of such an identifier. 

Maximum likelihood techniques have been used for parameter identification 
for many years. Lee [18], in his book published in 1964, claims that Fisher [8] 
first developed identification using maximum likelihood techniques. The concept 
of recursive maximum likelihood identification using a Newton- Raphson type opti- 
mization technique and Kalman filter equations was originally conceived by Stepner 
and Mehre [25] in 1973. Their algorithm, which was designed to handle nonlinear 
as well as linear dynamics, was very computationally intensive. In 1986, Fermelia 
[7] further expanded the concepts, and Sjodin and Fermelia [24] developed working 
code for a first order dynamics model in 1987. Sjodin and Fermelia’s algorithm was 
much simpler in concept, thus giving it a much better chance for real-time imple- 
mentation. Kelly [14] and Fermelia extended this work to multiple second order 
dynamic models in 1989. 

2.2 System Model 

This dissertation discusses an adaptive Kalman filter design where the system model 
is defined in state-space form. Consider a system described by 

x = Fx + Gu + w (1) 

z = Hx + v. fo) 
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The noise vectors, w and v , are assumed to be normally distributed with a mean 
of zero. 

In order to obtain a discrete-time model of the above system model, it is as- 
sumed that the set of discrete-time points {0, 1, ..., k, k + 1} are sufficiently 
close together that piecewise constant approximations may be made. The solution 
of x = Fx + Gu for such an interval may be expressed as [2] 


•Hk+i 


f fc+1 

*&k+l,k%.k I ^fc+l,T G T d,TU k . 
Jk 


(3) 


2.3 Defining the Performance Index 

In this section, a performance index is defined for RML identification. Since the 
identification technique is a recursive maximum likelihood method, the log likeli- 
hood function must first be defined. To identify the system parameters, the log 
likelihood function must be maximized. This function is maximized by minimizing 
its negative term. This negative term is chosen as the performance index. 


2.3.1 The Log Likelihood Function 

The identification method that is developed in this section is a recursive maximum 
likelihood method. Variables that are vectors rather than scalars are underlined. 
Variables that are estimated or identified have a hat, such as x_. First, define a log 
likelihood function, £(#), as 

£ (0 = In [p(Z_\0) ] (4) 

where 0 is a vector of unknown parameters and p(Z_\9) is the conditional probability 
density function of the observations, Z _ , given 6. The maximum likelihood estimate, 
<9, is the parameter vector that most likely caused the observations [24]. 

Repeated use of Bayes’ Law is used to derive an expression for £ (9). Let Z_ k+1 
be the set of all observations at time k + 1, or 

Z_ k+1 = [z t z 2 ■■■ z k +i]- ( 5 ) 

Now, p(Z_ k+ 1 1£) may be expressed as 

p(Z k+1 \9) = p(zi 2 2 • ' • ^/c+i|£) • ( 6 ) 

C(0) may now be written as 

A;+l 

C(9) = In fl pUilZt-ufi)- 
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If the noise values, Wj. and v k+1 , are normally distributed, is 

normally distributed. From [24], 

= [(2n) m det B]~ 1 ^ 2 exp( — -vf B~ l v { ) (8) 

2 

where 


m = dim [u] 
B d A f E(vv T ) 


Substituting this into the Equation 8 gives 


&+1 - 

C(0) = \n(\{[{2*) m dztB]- l l 2 exp(-\vJ B' 1 Ki )) 

i'= 1 2 

= — m(k + 1) In (27r) 

*+i i 

-E 2 ( ln ( rfe<5 ) + eJ b- 1 v t ). 

1=1 Z 


( 9 ) 


2.3.2 The Performance Index 


Now that the log likelihood function has been defined, an expression for the perfor- 
mance index must be found. In Equation 9, C(9) is maximized if the summation 
expression is minimized. Consider the following performance index, 

k-\-l i 

Jk+\(0) = 9 ( ln i det B ) + vf B~ 1 Vi) (10) 

to be minimized. 

^ Jk+ i(d) is expanded using a Taylor Series expansion, one obtains 


Jk+ l(@) — Jk+l(0 ) + 


30 


0=0*69 


2 d9 2 


I o_=e*69 2 + ... 


( 11 ) 


where 8* is the current value of the parameter, 9. 

If third and higher order partial terms are assumed to be negligible, the above 
expression can be solved for 60, the parameter error. At steady state, it is desired 
that J k+ i(8) - J k+ i(9*) = 0. What remains of the Taylor Series expansion is 


0 


dJ k+ i(g) 

d8 


0=0*68 -f 


2 d9 2 


0=1*69; 2 . 


( 12 ) 
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Solving for the parameter update, the following expression is obtained: 


se 


- 2 


d 2 J fc+1 (0), 

d?~ k = r 


awffl , 

de 


(13) 


The parameter update, 6 new is found by adding the error in the parameter, 60, to 
the current value of the parameter, 0^- 


Lew = Lid + SQ- 


(14) 


Equation 13 is very similar in form to the recursive Newton- Rap hson algorithm. 

The first and second partials are found by differentiating J k+ x (0) from Equa- 
tion 10. The error covariance matrix, B, is assumed to be constant once steady 
state has been reached. Thereby, the first term of Equation 10 may be ignored 
when the partial is taken, giving [1] [24] [25] 


dJk+ 1 ( 0 ) duj 

~w~ = h~d« 

PJm (ffl _ v- 1 
de 2 “ de of 

The error covariance matrix B is defined as [20] [25] 


(15) 

(16) 


B = 


1 

k + 1 


fc+1 


ILiU-i 




(17) 


The error covariance matrix B contains a vector, u, multiplied by its transpose, 
v. Because of this, B will tend to be singular for the first and second iterations. 
This singularity will cause difficulties in solving for B 1 . Depending upon the 
dynamics of the system, the identifier generally works well if B 1 is reinitialized 
on or about the third iteration. Hence, one solves for B on the first two iterations, 
but not for B~ l , §J or 0 . Then on the third iteration, begin solving for all 

identifier values. 


2.4 RML Identification Algorithm 

The next two sections of this chapter discuss the matrix (multiple identified pa- 
rameters) form of RML identification. The first section covers the details of the 
derivation of the matrix form of RML identification. This is followed by a section 
describing the procedure for matrix RML identification. 
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2.5 RML Identification Algorithm 

The recursive identification parameter update algorithm is described by Equa- 
j tions 13 through 17. Equation 13 is comprised of Equations 15 and 16. The 

term of these last two equations is now described. Since the following derivations 
rely heavily upon the Kalman filter equations, Table 1 [9] is presented as an quick 
reference of the set of Kalman filter equations. 


Table 1: Summary of Kalman Filter Equations 



Kalman Filler Equations 

Process Model 

£*♦ i = + iU- ILk *'* -V (fl. Qi ) 

Measurement Model 

Lk + l = + lh»l A (Q- R«) 

State Estimate Extrapolation 


Error Covariance Extrapolation 

= Qk'HAPk/k*k+\J c + Qk 

Error Covariance Update 

1/t + l =s [I — hk*r)Hk+\] ^kfl/k 

Kalman Gain 

A*4l — + [H*4 VPk±l/kHk+l + A,*]! 

State Estimate Update 

itxl/i-rl = £*41 /* + A *41 [^ 4 ! — H* 4 if i ^ J/it ] 


First, define a variation in as the error between the desired innovations, 
Kk+i(D), and the incorrect innovations, v k+l (I). 

S &+i = K k +i(D) - u k+1 (I). (18) 

The desired innovations can be viewed as the innovations expected for a Kalman 
filter whose dynamics match those of the system being modeled. The incorrect 
innovations can be viewed as the innovations expected from a Kalman filter whose 
model dynamics do not match those of the system being modeled. 

In order to obtain an expression for Su k+1 , begin with the Kalman filter 
expression for the innovations. 

F-k+i = lfc+i ~ Zk+i/k- (19) 

Then, observing the variation of both sides, 

f>Hk+i = — i*+i/y *)• (20) 
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Since there is no error in 2 ,, +I due to errors in the system dynamics or modeling, 

fe* + i=0.Thus, ,, n 

8u k+ 1 = -Ks.k+1/k) 

Assume that the unknown or changing parameters exist only in $*+i,*> the 
Kalman filter state transition matrix. Using the Kalman filter equation for z k+1/k 
from Table 1, expand to get 

8v_ k +\ ~ — ^ \Hk+l^k+1,k¥jc/k\ ■ 

The parameters to be identified occur only in 4> fc+1)fc , the state transition matrix. 
Therefore, 

— ^Hk+l^k+l,kik/k + Hk+l$k+l,k&iLk/k' 


8v 


■k + 1 


where 


— 


' d$k+l,. 

p +1 df 

~2Ljfc/fc + -fffc+l^fc+l, 

* d0 T . 

86. 

(23) 

may be 

expressed as 









d<j>n 

3<l> 12 • • • 

@4* In 





a* 1 


d<j> 21 

34)22 • • ■ 

34>2n 



(24) 




3<f>n 1 

34>n 2 • ' • 

34)nn _ 




d<t>ij 

= 

+ 

00 1 

<m 2 + 

... + 

d<t>ij 86. 
36 n 1 

n 





36 


T 86. 


(25) 


Let the terms contained by the brackets in Equation 23 be represented by a 
matrix A k +\- 

d&k+l k ~ .. I dx_k/k 

A k+ 1 = H k + 1 -%k/k + Hk+l$k+l,k qqT ■ 


Then, 


36! 

Mti = -A t * 
36 


(26) 

(27) 


The first term of A k +i may be realized by the following algorithm [5]: 


Hk+\8^k+\,ki.kjk -fffc+l 


r T 

—k/k ar 

o T 302 
— k/k d$T 


t T 

—k/k goT 


86 


= H k +i Mk+i 86 


(28) 
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or 


<9$* + 1 k « 

Hk+\ QqT * — k/k — ^ k+\Mk+l 


( 29 ) 


where 4>ij are elements of $k+i,k and 

4 ) i = [ 4>n 4*12 

4*2 == [ </>21 4*22 


4>m] T 

4 > 2 n] T 


4 > n ~ [ <^nl 4 ) ti2 * ’ * ^nn • 

An expression must now be found for the second term of Ak +\ . If an expression 
can be found for — then is simply the value of from the last 

iteration. Let a matrix B k+1 be defined as 


B 


k + 1 


d(£fc+i/fc+i 

ae T ' 


(30) 


Then, B k+X from the last iteration is defined as 


D d £k/k 

Bt = -^ 


(31) 


Again, using the Kalman filter equation for i i/t + 1 from Table 1, the following 
expression is derived 


&k+ \f>Q. — fix.k+l/k+1 


= 8 


&k+i, k %k/ k + Gk+iKk+i] 

d^k+hk - i 

<90 T - fcA + ae T 

I dG k+! r du k+ 1 

+ ia+1+Gk+i-gr 


86. 


(32) 


Thus, i? fc+1 may be written in terms of M k+1 , B k and A k+X as 

B k + 1 = M/; + i + $ k+xk B k 

, ^Gfc+l ,0 A 

"*■ qqT ^t+1 - ^fc+l^fc+1- 

Let a matrix CV+i be defined such that 

r< _ ^fc+i 

° fc+1 _ ~ k+1 


(33) 


(34) 
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or 


C k+1 86 = SGk+iZk+v ^ 35) 

An expression for ^ is found next. Again, expand using the Kalman filter 
equation for G k +\ from Table 1. 


8G k + 1 — 


OPk+l/k+l rjT D-l 
-tt n k+1 n. k+l 


06 


86. 


Expand - k ^ k±L the same way. 


8P k+ i/fc+i = [I - G k+ iH k+ i]8P k+1/k - 8G k+1 H k+ iP k+ i/ k . 
T k + 1 = I — G k+ iH k +i 


Letting 

Equation 37 becomes 

8P k +\/ k +\ = 

Thus 


0P k + i/fc 5G fc+ i „ p 

r* + i-^r W ~ Hk+1 f 


06 


j 1 k 


86. 


?Zi±pi = r t+1 ^ _ 


Now ap fc+ 1 /* ±i ma y be described as 

’ dO 1 


d _Ii±l!±± l = - d -^-H M P M/t 


06 


G k +\H k +i — f 


OPk+i/k 

06 1 


and substituting 8P k+ i/ k +i into Equation 36 yields 

OPk+i/k h t d_i 

1 fc-H 


(36) 

(37) 

(38) 

(39) 

(40) 


(41) 


8G k+ 1 = |i fc+i qqT n k+\ ri k+i 

[i + H^Pk+i/kHl^RlU ] _1 86. (42) 

Introduce the matrix V k+ i where 

V k +\ = H k+ 1 R k h\l + H k +iPk+i/kH k+ iR k +i\ Kk+ 1- (^ 3 ) 

Then, post multiplying Equation 42 by j/* +1 , an expression for G*+i is obtained 


as 


^ 0G k+ 1 

Gk + 1 — — fc+1 

p 0P k+ l/k y 
- U +I — r-U + . 


(44) 
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Letting 


n — dP ^V 

* +1 “ ~W~ * +1 

allows Cjt+i to be expressed in terms of a matrix Djt+x • 

Ck + 1 = Tyt+lDyt + l 

Next, an expression for D k+1 is found as 

D k + \89_ = fiPk+i/kVk+i 

= + $k+l,k SPk/k Uk + 1 

+ $k+i,kPk/k 6$l +itk Vk+\ 

Wk+l = P k /k$l+l t k V h+l 

Uk+1 = H+l,k V k+l- 


(45) 


(46) 


where 


(47) 

(48) 

(49) 


Using the same technique as in Equation 28, the first term of the D k+ i expres- 
sion may be written as 


6$k+i,kWk+i 

= Sk+iSO 


WT Hir 

VV k+\ agT 

W7 Th, 

vy k + 1 


W7 2 ^ 5 - 

,K fc+l JgT 


86 


(50) 


The third term can be written as 


&k+i,kPk/k S* T k+1 , k V k+1 = $k+i,kPk/k 


yT W 1 
V k+1 

V7 Ttl 

V k + 1 WT 


V T 7*1 

V k + 1 W 

$k+i,kPk/kNk+i86 


86 


(51) 


where 


01 — [ 011 021 • • • 0nl ] T 

02 = [ 012 022 - ‘ - 0n2 ] T 


[ 01n 0 2 ti 


07] 
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Let the second term of the D k + 1 expression be written in terms of a matrix E k+U 

$ k +l, k 8Pk/kU k +i — $k+l,kEk+l&(L- (^) 

Combining all three terms for D k + 1 gives 

D k + 1 = $ k +i,kEk+i + $k + 1 + $k+i,kPk/kNk+i- ( 53 ) 

An expression for E k ^.\ must now be found. Equation 52 defines E k +\ as 

Ek+M = SPk/kUk+i. ( 54 ) 

Using the Kalman filter equation for P k/k yields 

6P k/k = SPk/k-i - SP k i k H T k R- k l H k P k/k . _i - P k / k H k R k 1 H k 6P k / k - i . (55) 

Solving for 6P k / k und post multiplying by U k +\ yields 

SP k / k U k+ \ = T k 8P k / k -iY k+ i (56) 

or 

E k+1 66 = r fc 6P fc/fc _ 1 n+i ( 5? ) 

where 

Y k+1 = T k U k+ i (58) 

T k = I + H T k R- k l P k / k - (59) 

Let a matrix F k+1 be defined as 

F k+1 8$ = 6P fc/fc _ 1 r fc+1 (60) 

such that E k+ i is expressed in terms of F k+ i. 

E k+ 1 = r,F fc+1 (61) 

The matrix F k + 1 is expressed in terms of D k , the previous value of the D k + i matrix. 
Since 8P k / k -\ is symmetric, 

F k+1 80 = 8P k / k -iY k+ i 

= V£Vj 8P k / k .,Y k+l 



= V k * (D k 80f Y k+1 

(62) 

where V k is defined as the pseudo-inverse of V k [26], or 



v: = v t [v?v t Y' . 

(63) 

This allows F k+ i to be expressed as 


F k+ 1 = 

' v;Y? +1 d 2 ■ ■ ■ v t -Y^d, ] 

(64) 


where dj is defined as the j th column of D k . 
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3 Matrix RML Identification Procedure 

The identification algorithm has now been derived for the matrix (multiple 
parameter) case where only the state transition matrix, is a function of the 

parameters. The procedure for using the matrix form of RML identification is now 
explained. There are six major steps, with steps five and six having several substeps. 

1. Set B k equal to B k+ i of the last identifier iteration. If this is the first 
iteration, set it equal to some small reasonable number. The user may have 
to try several different starting values in addition to letting the identifier 
iterate several times in order to determine a reasonable initial value. 

dt/ T 

2. Calculate ~^ l ~ 1 using Equation 27. 

3. Calculate the error covariance, B , using Equation 17. 

4. Calculate the first and second partials of Jk+\ using Equations 15 and 16. 

5. If ready to update, 

• Calculate the parameter error vector, 60 , using Equation 13. 

• Update the parameter vector, 0 , using Equation 14. 

6. If not ready to update, solve for B k +i to be used as Bk in the next iteration. 
To do this, 

• Set Dk , T k , V k and I\ equal to D k+ 1 , T k+i , V*.+i and r*. +1 , respectively, 
from the previous iteration. From the last iteration of the Kalman filter, 
get the values for P k/k , x k/k , P k+l/k , G k+l , H k+1 and R k+1 . 

• Calculate: 

(a) V k from Equation 63 

(b) V k+ i from Equation 43 

(c) U k+ i from Equation 49 

(d) Y k+ i from Equation 58 

(e) F k+1 from Equation 64 

(f) E k+ 1 from Equation 61 

(g) N k+ i from Equation 51 

(h) W k +i from Equation 48 

(i) S k+ i from Equation 50 

(j) D k+ 1 from Equation 53 

(k) r t+1 from Equation 38 

(l) C k+ 1 from Equation 46 

(m) B k+ 1 from Equation 33 
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4 Attitude Determination Example 

This section discusses an application of AKF-RML to a spacecraft attitude 
scenario. First, the dynamic equations are developed. Next, the state space model 
for the dynamic equations is explained. Finally, results are shown using simulated 
data. 

4.1 Dynamic Equations 

Assume the attitude of a spacecraft may be described using Euler’s equations [12], 

Il—r— = N\ + (I 2 — I 3 ) (65) 

ot 

I 2 6 -^l = N 2 + (h-I i)w 3 u>, ( 66 ) 

ot 

I 3 -Z— = AT 3 + (Ji — I2)ll>iu)2 (67) 

ot 

where /, represents the inertia about the ith axis, oj, is the angular velocity about 
the ith axis and N% is the applied torque about the ith axis. 

If torque-free motion (iV,’ = 0 ), symmetry of two of the inertias ( I\ = I 2 It) 

and constant velocity in the third axis (ui 3 = n) is assumed, then the above equations 


become 


It c . — — (h — It) U 2 W 3 
ot 

( 68 ) 

It 77 = (I 3 ~ It)u 3 <^i 

ot 

(69) 

t 8(jJ 3 _ n 

It st ~ 

(70) 

Differentiating Equation 68 yields 


Jjw'i = — (I 3 — It) W 2 W 3 . 

(71) 

Multiplying by It and substituting in Equation 69 gives 


IjiUl = — (I 3 — It)u3Itu>2 

(72) 

= — (h — It)“> 3 (h ~ It)^>3^1 

(73) 

= — (I 3 — It ) 2 

(74) 

(I 3 -ITX 2 

- - ( if ) 

(75) 

Integrating Equation 70 then yields an expression for u >2 as 


u > 2 = (^ 3 J ~) W 3‘*>1< 

(76) 

where t is the step size. 
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4.2 State Space Model 


Equation 75 is in the form of a simple undamped harmonic oscillator. Therefore, it 
may be expressed in continuous state space form as 


fi 


0 

1 ‘ 


x x 

X2 


-u> 2 

« 

0 


x 2 


or in discrete state space form as 


x x 


x 2 

k+1 


COS OJ n t 

—u n sin Lo n t 


— sin u> n t 

W n 71 

COS LO n t 



where 



(77) 


(78) 

(79) 


4.3 Attitude Determination Results 

The example described in Sections 4.1 and 4.2 were implemented on a XT-compatable 
PC. The true natural frequency, u > n , was set to — 6.0 radians. The natural frequency 
in the Kalman filter dynamics was assumed to be unknown, and the identifier set 
up to solve for the true value. 

In the first test case, AKF-RML was set up to operate in a pseudo-batch mode. 
In this mode, the identifier is actually solving for the unknown parameter at each 
iteration, but the parameter is updated every k iterations. Figure 1(a) shows the 
results of this test case with k set to 70 iterations and the initial guess on u n equal 
to —6.3 radians. 

While this pseudo-batch mode is useful for analysis and to gain insight into 
the operation of the AKF-RML algorithm, the goal is still to operate recursively. 
Figure 1(b) shows the results of recursive AKF-RML with the initial guess of ui n at 
—6.6 radians. 


5 Summary 

Adaptive filtering is rapidly gaining popularity as a method of estimating sys- 
tems with unknown or changing dynamics. This paper offers a recursive identifica- 
tion algorithm that is designed to be used in conjunction with a Kalman filter. 

In [14], the recursive maximum likelihood identification algorithm is developed 
and tested. Extensive testing is accomplished using simulated data, beginning with 
the simple first order, decaying exponential case. This is extended to second order 
sprmg-mass dynamics, with excellent results obtained for both of these cases. Next, 
damping is added to create the well-known spring-mass-damper dynamic case. Very 
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Figure 1: AKF-RML Results in (a) Batch Mode and ( b ) Recursive Mode 



good results are obtained when identifying the natural frequency or damping coef- 
ficient individually. Problems arise, however, when both parameters are identified 
concurrently. This problem presents itself whenever the parameters to be identified 
are not of the same magnitude, and is solved by the addition of a scaling matrix to 
the parameter update equation. 

The identification algorithm developed in this paper may be computationally 
intense in some applications. As with all Kalman filter algorithms, the computa- 
tional needs rise quickly as the number of states and observations increase. The 
identification algorithm computational needs will rise not only with an increase in 
the states and observations, but with an increase in the number of identified pa- 
rameters as well. Another possible disadvantage is the trial and error method that 
is currently used to find the parameter scale factors. The use of scale factors is 
actually not a disadvantage against this identification algorithm alone, as similar 
scaling or weighting matrices are used in many current identification algorithms 
when identifying parameters of different magnitudes. In addition, maximum likeli- 
hood techniques tend to converge poorly when the initial conditions are far away 
from the true conditions. In most practical applications the users should be able to 
arrive at reasonable initial conditions. 

The advantages of using this adaptive filter design are many. Incorporation 
of a Kalman filter estimator in AKF-RML allows the designer to choose system 
states that relate to real-world entities such as position, velocity and acceleration. 
In the case of aircraft or satellite applications, for example, those states can then 
be passed on to various payloads for pointing requirements. RML identification is 
designed specifically to be used in conjunction with the Kalman filter. Therefore, 
this adaptive Kalman filter design may be implemented for systems whose dynamics 
are unknown or varying. 

In addition, the RML identification algorithm described in this paper is able to 
handle relatively high levels of noise. The common problem of insufficient excitation 
prevents parameters from being identified at very low noise levels, but this problem 
disappears as noise levels are brought up enough to provide sufficient excitation. 

Results are shown for a simple spacecraft attitude determination example. 
Plots are presented for two cases. The first case shows the results of AKF-RML 
in batch mode where the parameter is updated after a series of iterations. Next, 
results are provided of AKF-RML in recursive mode. More research needs to done, 
especially in the area of choosing initial conditions, in order to get AKF-RML to 
operate efficiently in recursive mode. 
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